Range and velocity sensing system

ABSTRACT

The present invention relates to a method and apparatus used to calculate at least one velocity component for a target within the region. The invention employs an energy source which is activated using an activation system in a cyclic pattern with a selected source frequency. A receiver is also employed in conjunction with a shielding system where this shielding system is configured to block the sensing of reflected energy from the target in a cyclic pattern with a selected receiver frequency. The invention operates through measuring a frequency change in the source frequency of the energy source signal when received by the receiver and determines a velocity component for a target based on a measured frequency change for a known direction of travel. The invention may also be extended to provide a two or three dimensional velocity vector through the addition of further energy sources.

CROSS REFERENCE TO RELATED APPLICATION

This application is a national stage application under 35 U.S.C. 371 of PCT Application No. PCT/NZ2005/000241 having an international filing date of 13 Sep. 2005, which designated the United States, which PCT application claimed the benefit of New Zealand Patent Application No. 535322 filed 13 Sep. 2004, the entire disclosures of which are hereby incorporated herein by reference.

TECHNICAL FIELD

This invention relates to a range and velocity sensing system. Preferably the present invention may provide an input system for machine vision applications whereby machinery or robotics are given feedback on an environment. However, applications outside of machine vision that are also envisioned and reference to the above only throughout this specification should in no way be seen as limiting.

BACKGROUND ART

Simple range sensing systems which can quickly determine the range to one target or point are well known. These systems can be used in many applications, from determining a golfer's distance to the hole they are playing, to surveying applications to calculate the distance between specific landmarks or points.

These systems normally employ a laser range finding system where a laser beam is trained onto a selected target, and a receiver associated with the system calculates a distance or range to the target through the propagation delay of the laser beam.

However, these systems cannot necessarily be used easily where the range to multiple targets needs to be calculated simultaneously or in a very short period of time. For example, these types of “single target” range finders cannot necessarily be used effectively in machine vision applications which employ range information for all targets with a scene as inputs to object identification algorithms.

One attempt to provide a range finding system for such applications can employ a laser range finder substantially as described above, which has the laser beam scanned over the region of interest and all targets within such a region. However, this approach is not ideal as mechanical systems are required to physically move the laser source to provide the scanning motion required. Furthermore, significant computation or processing power is also required to calculate the range of a number of discrete targets using the propagation delay associated with multiple scans of the laser beam. Range information must be calculated separately for each scanning movement of the laser, which will require high performance computer processing power to ensure that the range information can be provided at an effective or useful speed.

A discussion on scanned laser systems above can be found in U.S. Pat. No. 5,638,164 and in D. Tu, “Range Image Acquisition for Machine Vision”, Optical Engineering, 37(9), pp 2531-5, 1998.

Another alternative range sensing system has also been developed to address these problems associated with scanned laser range finding systems, and is discussed in U.S. Pat. No. 6,100,517. This system employs a light or energy source and associated light or energy sensor both of which are pulsed on and off at the same frequency. Energy from the pulsed source is reflected from the targets within a particular area or region back towards the energy sensor, which again is enabled or activated in a pulse manner so that this reflected light will only be sensed when the sensor is activated.

The selective activation of the sensor is implemented through a shutter or gate placed between the sensor and any targets within a scene, and this shutter is open and closed at the correct pulsing frequency required. The frequency at which the source and sensor are pulsed is selected so that the amount of light reflected from distant targets is cut off after a set propagation delay, as opposed to light reflected from near targets which has a lower propagation delay. Light will be received from near objects for a longer period of time than light reflected or scattered from more distant objects. Therefore, more light will be received from near targets than distant targets, which gives a light intensity value or reading for a target which is proportional to its range from the sensor.

This type of system can be implemented with relatively low cost components and does not require the level of computational processing power which the scanned laser range finder discussed above requires. However, there are additional variables present in the operating environment of the system which can cause inaccuracies or errors in the resultant data obtained.

Changes in ambient light level (and therefore the amount of light received by the sensor) will provide an offset error in the results obtained. Furthermore, targets within a particular scene which have relatively high or low reflectance properties will also create errors in the output obtained, as the amount of light received by the sensor will vary not just with the range of the target from the sensor. Such systems that derive range values from intensity information are also ultimately limited in range resolution by the dynamic range of the sensor employed. If a low cost or low quality sensor, then the performance or accuracy of the range value derived in turn suffers.

Furthermore, it is also preferable in some instances to be able to sense the velocity of an object moving within a scene or region. Such velocity information may preferably give an indication of an object's velocity in three dimensions to allow the motion of the object to be tracked and its trajectory to be plotted. Furthermore, such velocity sensing facilities will also be of advantage when used in combination with a range sensing system in automated machinery.

An improved range sensing system which addressed any or all of the above problems would be of advantage. Specifically a range sensing system which could be implemented using relatively low cost componentry, which did not require a high degree of computational processing power and which also did not suffer from inaccuracies due to changing ambient light levels nor variable reflectance properties of targets would be of advantage. Furthermore, an improved system which will provide velocity measurements or indications, potentially in three dimensions, will also be of advantage.

All references, including any patents or patent applications cited in this specification are hereby incorporated by reference. No admission is made that any reference constitutes prior art. The discussion of the references states what their authors assert, and the applicants reserve the right to challenge the accuracy and pertinency of the cited documents. It will be clearly understood that, although a number of prior art publications are referred to herein, this reference does not constitute an admission that any of these documents form part of the common general knowledge in the art, in New Zealand or in any other country.

It is acknowledged that the term ‘comprise’ may, under varying jurisdictions, be attributed with either an exclusive or an inclusive meaning. For the purpose of this specification, and unless otherwise noted, the term ‘comprise’ shall have an inclusive meaning—i.e. that it will be taken to mean an inclusion of not only the listed components it directly references, but also other non-specified components or elements. This rationale will also be used when the term ‘comprised’ or ‘comprising’ is used in relation to one or more steps in a method or process.

It is an object of the present invention to address the foregoing problems or at least to provide the public with a useful choice.

Further aspects and advantages of the present invention will become apparent from the ensuing description which is given by way of example only.

DISCLOSURE OF INVENTION

According to one aspect of the present invention there is provided a range sensing system which includes,

at least one energy source adapted to emit energy capable of reflection by one or more targets within a region, and

at least one receiver adapted to sense the reflection of emitted energy from said at least one target within said region, and

an activation system associated with said at least one source, said activation system being adapted to activate and deactivate an energy source in a cyclic pattern with a selected source frequency, and

a shielding system associated with said at least one receiver, said shielding system being adapted to block the sensing of reflected energy from a target by a receiver, said shielding system being activated and deactivated in a cyclic pattern with a selected receiver frequency, wherein an output signal of a receiver is compared with a reference signal to determine a range value for a target from the receiver, with phase differences between the receiver signal and reference signal indicating a range value.

According to a further aspect of the present invention there is provided a range sensing system substantially as described above wherein said source frequency and receiver frequencies are selected from different values.

According to yet another aspect of the present invention there is provided a range sensing system substantially as described above wherein a processing means is used to compare an output signal of a receiver to a reference signal to determine a range value for a target from the receiver.

According to a further aspect of the present invention there is provided a range or velocity sensing system substantially as described above wherein the source frequency used is frequency locked with respect to the receiver frequency used.

According to a further aspect of the present invention there is provided a range sensing system substantially as described above wherein the source frequency used is phase locked with respect to the receiver frequency used.

According to yet another aspect of the present invention there is provided a range sensing system substantially as described above which is adapted to use a number of paired source and receiver frequencies to vary the distance over which range values can be indicated.

According to yet another aspect of the present invention there is provided a method of calculating ranges to a plurality of targets within a region, characterised by the steps of;

-   (i) activating an energy source using an activation system, said     source being activated and deactivated in a cyclic pattern with a     selected source frequency, and -   (ii) operating a receiver using a shielding system, said shielding     system being adapted to block the sensing of reflected energy from a     target in a cyclic pattern with a selected receiver frequency, and -   (iii) comparing a receiver output signal with a reference signal to     determine a range value for at least one target, where phase     differences between the receiver output signal and reference signal     indicate said range value.

According to a further aspect of the present invention there is provided a method of calculating at least one velocity component of a target within a region, characterised by the steps of:

-   (i) activating an energy source using an activation system, said     source being activated and deactivated in a cyclic pattern with a     selected source frequency, and -   (ii) operating a receiver using a shielding system, said shielding     system being adapted to block the sensing of reflected energy from a     target in a cyclic pattern with a selected receiver frequency, and -   (iii) measuring a frequency change in the source frequency of the     energy source signal when received by the receiver, and -   (iv) using the measured frequency change of the source signal to     calculate a velocity component of the target in a known direction.

According to a further aspect of the present invention there is provided a velocity sensing system which includes,

at least one energy source adapted to emit energy capable of reflection by one or more targets within a region, and

at least one receiver adapted to sense the reflection of emitted energy from said at least one target within said region, and

an activation system associated with said at least energy source, said activation system being adapted to activate and deactivate an energy source in a cyclic pattern with a selected source frequency, and

a shielding system associated with said at least one receiver, said shielding system being adapted to block the sensing of reflected energy from a target by a receiver, said shielding system being activated and deactivated in a cyclic pattern with a selected receiver frequency, said source frequency and receiver frequencies being selected from different frequency values, and a processing means configured to measure a frequency change in the source frequency of at least one energy source signal when received by a receiver and to calculate a velocity component of a target in a known direction from said at least one measured frequency change.

The present invention is preferably adapted to provide a range sensing system which can simultaneously or in a short period of time provide range values for a plurality of targets within a selected region. In a further preferred embodiment the present invention may be used in machine vision applications where such range information from a plurality of targets can be used in object identification algorithms.

The present invention may also preferably be adapted to provide a velocity sensing system which may be used to measure the velocity of a target in at least one known direction. Furthermore, the present invention may also be extended to measure the velocity of a target in a number of directions, thereby facilitating the calculation of a two dimensional or three dimensional velocity vector for a target.

Reference throughout this specification will also be made to the present invention being used as a range and/or velocity sensing system, which is preferably employed in a machine vision application. However, those skilled in the art should appreciate that other configurations of the present invention are envisioned and reference to the above only throughout this specification should in no way be seen as limiting.

Those skilled in the art should appreciate the present may be used to implement a stand alone range sensing system, or a stand alone velocity sensing system, or a system which measures both range and velocity. Reference in the specification below will be made to the present invention being implemented as a range sensing or velocity sensing system, but those skilled in the art should appreciate that substantially the same apparatus employed to implement a range sensing system may also implement a velocity sensing system and vice versa.

Furthermore, reference throughout this specification will also be made to the present invention being used to provide range values or indications for a plurality of targets within a region simultaneously. Those skilled in the art should also appreciate that some propagation or processing delay may also be present in the provision of such values due to technical limitations of the equipment used. The term simultaneously referred to throughout this specification refers to events occurring substantially at the same time.

Preferably the present invention employs at least one energy source which is adapted to emit a form of energy which can be reflected or scattered from targets within a selected region. The energy source employed can emit any number of different spectra or energies with variable frequencies depending on the particular application which the present invention is to be employed. Furthermore, the energy emitted from a source may be substantially diffused in some embodiments or alternatively focused into a cohesive beam in other embodiments if required.

In a further preferred embodiment the present invention may include a single energy source only which has a substantially diffuse emission pattern for the energy that it generates or emits. Such a single energy source can be used to expose an entire region of interest to energy capable of reflection by targets.

In a further preferred embodiment the energy source employed may emit energy from the visible light spectra. Visible light energy emitters are well known and also inexpensive to produce or obtain. Furthermore, a visible light energy source such as for example, a common LED can also be easily configured and operated to illuminate the region of interest.

Reference throughout this specification will also be made to the present invention employing a single visible light energy source in the form of a LED which radiates a diffused pattern of visible light. However, those skilled in the art should appreciate that other configurations or numbers of energy sources which can emit different spectra or frequencies of energy may also be employed in conjunction with the present invention if required.

In a preferred embodiment the present invention also includes at least one receiver adapted to sense the reflection of emitted energy from said at least one target within a region of interest. Those skilled in the art should appreciate that the type of receiver employed will be determined by the spectra or frequency of the energy emitted by the energy source used. For example, in a further preferred embodiment where a light emitting diode (LED) is used as an energy source, a visible light responsive sensor or sensors may be employed in conjunction with the present invention.

Other light sensors can include CMOS cameras, Vidicon tubes, photodiode arrays and photomultiplier arrays.

In a further preferred embodiment the present invention may employ a single receiver only. A single receiver may be configured to provide adequate coverage of the region of interest thereby substantially simplifying the design of the system provided and also reducing its manufacturing cost.

In a preferred embodiment a receiver used may be provided through some form of charge couple device (CCD) such as for example, a CCD camera well known in the art. Such devices or cameras have many varied uses and are produced in large numbers at relatively low cost. Furthermore, a CCD camera can also provide effective coverage for a large or wide region of interest through sensing the reflection of visible light from targets within such a region.

Reference throughout this specification will also be made to the present invention employing a single CCD camera only as a receiver of reflected energy. However, those skilled in the art should appreciate that other configurations of the present invention which employ different types and numbers of receivers are also envisioned, and reference to the above only throughout this specification should in no way be seen as limiting.

In a preferred embodiment the present invention also employs an activation system. Such an activation system can be associated with the energy source to activate and deactivate the source with the cyclic pattern. The activation system can be configured to pulse the energy or light source on and off with a particular regular source frequency.

An activation system as discussed above may be implemented in many different ways depending on the particular application for the present invention. For example, in one instance the activation system may simply consist of a power supply for an energy source where the source frequency employed is used to enable and disable the supply of power to an energy source at the source frequency. However, those skilled in the art should appreciate that other implementations of an activation system are envisioned and reference to the above only throughout this specification should in no way be seen as limiting.

Preferably the present invention may also include a shielding system which is associated with the receiver employed. Such a shielding system can be operated to block the receiver sensing light reflected by targets within a region of interest. The shielding system may be activated and deactivated with a cyclic pattern to in turn block or enable the sensing of reflected light with a cyclic pattern. The shielding system and therefore in effect the receiver can be operated at a selected receiver frequency, therefore to provide a cyclic effect to the output obtained from the receiver.

A shielding system used in conjunction with the present invention may be implemented in a number of different ways. For example, in one possible embodiment a physical barrier such as a gate or shutter may be placed in front of a receiver with the shutter being opened and closed at the selected receiver frequency. Alternatively, in other embodiments the shielding system may be implemented with the components also employed to provide a receiver. For example, where a CCD camera is employed as a receiver such a shielding system may be implemented through control electronics also incorporated into the camera which enable and subsequently disable the sensing of light at the particular receiver frequency selected. Furthermore, those skilled in the art should also appreciate that other types of receivers such as CMOS or focal plane array transducers may also have a shielding system implemented through the control electronics incorporated into the transducer assembly employed. In addition, in other embodiments a shielding system may also be implemented through a gain modulated image intensifier if required.

Reference throughout this specification will also be made to a shielding system being formed from a shuttering or gating element which is pulsed open and closed at the receiver frequency employed. However, those skilled in the art should appreciate that other configurations of the present invention are envisioned and reference to the above only throughout this specification should in no way be seen as limiting.

In a preferred embodiment the source and receiver frequencies employed may be selected from different frequencies. These frequencies may preferably be slightly offset from one another with the size of the frequency difference being approximately equal to the operating frequencies employed by a relatively low cost signal processing and imaging acquisition equipment.

Those skilled in the art should also appreciate that many different types of wave form or wave functions with selected frequencies may be used to provide either or both the source frequency and receiver frequency. The selected frequency signals used to drive the activation and shielding systems can be formed from for example, pulsed square waves, triangular waves, sinusoidal waves or any other required type of wave function which exhibits the correct frequency required.

In a further preferred embodiment both the activation system and shielding system may be driven by receiver and source frequencies generated by a single signal generator. In such an embodiment the receiver and source frequencies generated may be frequency locked with respect to one another.

In a further preferred embodiment the signal generator employed can generate a receiver frequency which is phase locked with respect to the source frequency generated by the same equipment.

In a preferred embodiment the receiver employed is adapted to provide a receiver output signal which is analysed to determine the range values or indications required from the present invention. Due to the wave mixing effects provided through driving the receiver and source at slightly offset frequencies, a resultant receiver output signal can be obtained with a frequency equal to the frequency difference between the driving receiver and source frequencies. This output signal, which can have a substantially lower frequency than the source or receiver frequencies, can therefore be analysed and manipulated easily by relatively low cost signal processing and imaging acquisition components.

In this way the present invention can provide an optical or image heterodyning system which allows the signal processing equipment employed to function at relatively low frequencies when compared with the receiver and source frequencies. The optical mixing effects employed can be used to downshift the resultant frequency of interest to a lower frequency which can be easily analysed or manipulated.

In a preferred embodiment an output signal from a receiver is compared to a reference signal to provide an indication of a range value for a particular target within a region. The output signal obtained from the receiver may be generated from light reflected by a particular target, and in most instances would be represented by pixels generated through use of a CCD camera as a receiver. A single target or object within a particular region may therefore be represented by multiple pixels, with each pixel indicating range information for component portions of a target.

The reference signal to which the comparison is made can be obtained through a calibration procedure whereby the reference signal is equal to an output signal where the range of the target from the receiver is known. A calibration procedure can be employed in some instances to obtain one or more reference signals which are compared to a receiver output signal to indicate a range value.

However, in an alternative embodiment a reference signal may not necessarily be obtained through a separate calibration procedure. For example, in another alternative embodiment a reference signal may be obtained through the mixing together of the receiver frequency and source frequency. This will allow a resultant reference signal to be obtained of the order of the difference between the receiver and source frequencies, which will represent a signal which would be obtained from a target with a zero distance from the receiver.

In a further preferred embodiment the phase differences between a receiver output signal and the reference signal employed may indicate a range value for the target involved to the receiver. The extent of the phase difference between these two signals will indicate the displacement of the target from the particular range value represented by the reference signal. Those skilled in the art should appreciate that this is only one possible measurement scheme, and other well known schemes as such, but not limited to, continuous wave frequency modulation and pseudo random coding may be adapted for operation with the present invention if required.

In a preferred embodiment the comparison made between a reference signal and an output signal from a receiver can be completed through use of a processing means. Such a processing means may preferably be implemented through any one of a number of types of signal processing components which are capable of receiving the input signals required and assessing phase differences between same. In a further preferred embodiment a computer system may be employed to complete the processing work required to give range values or indications from the input signals it received. Such a computer system may also provide numerical range values for each pixel of information obtained from the region of interest, where this matrix or array of numerical data can then be further processed or used in the application required for the present invention.

This implementation of the present invention eliminates complications known in existing prior art systems caused by changes in ambient light levels or varying reflectance properties of targets within a region. As phase differences between a reference signal and an output signal of a receiver are employed to indicate range, this eliminates errors in the output of the system caused by variations in light intensity values still received. The phase comparison resolution, and hence the measured range resolution, is ultimately limited by the length of time sequence being analysed, assuming that there is a detectable level of signal. Furthermore, the mixing effect employed through using slightly offset receiver and source frequencies allows the componentry or equipment used to make such a phase comparison to operate at relatively low frequencies, and therefore be provided through relatively low cost components.

In a further preferred embodiment the activation system and shielding system may be driven by a number of paired sets of receiver and source frequencies. Selected pairings of receiver and source frequencies can be used to drive these components to in turn vary the distances over which the present invention can accurately determine range values.

As phase differences are employed to calculate range values a single selected pair of receiver and source frequencies will provide useful information only for a selected maximum range. Outside of this range the phase differences between the resulting output signal and reference signal may encompass more than one cycle, and therefore make it difficult to determine a specific range value. However, by operating the system to employ two or more paired sets of source and receiver frequencies the present invention may be operated to investigate a number of maximum range values for a particular region, thereby improving the flexibility and also the capacity of the system provided.

In a further preferred embodiment, these two or more paired sets of source and receiver frequencies use to extend the maximum range can be used simultaneously during only one measurement period when the frequency differences of each set of source and receiver frequencies are not the same. This allows each frequency difference to be processed independently during or just after a single measurement period to in turn provide information simultaneously on a wide number of potential range values.

In a preferred embodiment the present invention may be used to measure, determine or otherwise indicate the value of a velocity component of a target within the region or scene under observation. Preferably a frequency change or doppler shift in the energy source signal, and therefore the modulation ‘source frequency’ applied to the source signal may be used to measure the velocity component of a target in a known direction. Changes in the source frequency when detected at the receiver will therefore give an indication that the target involved is moving within the scene under investigation. Those skilled in the art should also appreciate that doppler shifts in the energy source signal will also be present in the lower frequency modulation signal applied to same, which in turn can allow the doppler shift experienced due to velocity of a target to be measured comparatively easily.

Preferably the velocity sensing system provided may be configured to indicate velocity values for a plurality of targets within the region involved. Those skilled in the art should appreciate that a single energy source and receiver pair may indicate velocity component measurements in a selected or a particular direction concurrently for a number of targets present within the region under investigation.

In a preferred embodiment a source signal from a single energy source may be used to determine a single velocity component of a target in a particular direction. The known direction of this velocity component may be equal to the direction of a vector which bisects both a vector extending to the energy source from the target, and a vector extending from target to receiver. This bisection vector will then point in the known direction to be indicated for the velocity component measured.

In a further preferred embodiment the present invention may be provided with or use a plurality of sources to in turn allow for the concurrent calculation of a plurality of velocity components for a target. These plurality of sources may preferably be spatially separated or displaced from one another to give varying directions of bisection vectors, which in turn can be used to provide varying calculations of velocity components in a single instant in time. Through the use of vector mathematics and the provision of preferably three or more sources, a true velocity vector giving the actual velocity of the target involved calculated in three dimensions may be determined.

In a preferred embodiment where a plurality of sources are provided, each source may be modulated or activated or deactivated at a different source frequency. Preferably the source frequency selected may be close to but not the same as one another to ensure the frequency separation between distinct sources can be used to resolve the signals of different sources via the receiver. A single receiver may then be used to receive simultaneously all three phase separated source frequencies to in turn allow for the calculation of a true velocity vector for a target at any instance in time.

In a further preferred embodiment a velocity value or indication may be extended to calculate an acceleration value or indication for the target involved. A time derivative of a velocity component will give an acceleration component value for the target, where the change in time used in the derivative may be selected over any convenient or appropriate period. For example, in one further preferred embodiment a time based acceleration derivative may be calculated over the time period in which valid receiver output data is placed onto or updated on the receiver output signal. In such an embodiment discreet acceleration derivatives may be obtained from the receiver data at the refresh rate of the receiver output signal.

This facility of the present invention may allow the relatively accurate acceleration value or indication to be calculated for a target with a minimum of processing power or processing time delay. Calculations can be made of acceleration components, or of the true acceleration vector for a target. A simple time derivative of received doppler shifted frequency information can be used to obtain such acceleration values or indications quickly using low cost or low power processing components.

The present invention provides many potential advantages over the prior art range sensing system.

The present invention can be used to provide a range sensing system which can operate quickly and effectively using the relatively low cost componentry. Such an implementation of a range sensing system may be used to provide an effective and useful system for machine vision applications.

Through sensing or determining range values by investigating the phase of a receiver output signal, the present invention also eliminates the complications normally present in the existing prior art systems caused by variable target reflectances or changes in ambient light levels in a region of interest.

Furthermore, the implementation of the present invention discussed above also allows relatively low cost signal processing equipment to be used to analyse the result of the output signal obtained, thereby substantially reducing the costs involved with implementing such a system.

Preferably, the present invention may also be used to sense, calculate or otherwise detect at least one velocity component for a target moving within the scene or region under investigation. Preferably a number of energy sources modulated with slightly varying source frequencies may be employed in such instances to allow for the calculation of a true velocity vector for a target and any instant in time. As the source frequencies of each source employed are doppler shifted to various degrees by the velocity of the target, a minimal amount of post processing calculation work is required to obtain the velocity value required. Simply through reading the received frequency for a source, an indication or measurement of a velocity component within a target can be directly measured.

In a further preferred embodiment the present invention may also be used to derive an acceleration value for a target within a scene or region under investigation. Preferably the velocity value or indication calculated or obtained as discussed above may be subject to a time derivative operation to obtain such acceleration indications both quickly and with low power and low cost processing components.

BRIEF DESCRIPTION OF DRAWINGS

Further aspects of the present invention will become apparent from the following description which is given by way of example only and with reference to the accompanying drawings in which:

FIG. 1 shows a schematic view of components employed to provide a range and velocity sensing system in conjunction with one embodiment of the present invention, and

FIGS. 2 a and 2 b illustrate plots of wave functions for signals employed by or generated by the system discussed with respect to FIG. 1.

FIG. 3 illustrates plots of wave functions for signals employed by or generated by the system discussed with respect to FIG. 1.

FIG. 4 shows velocity component vectors calculated in conjunction with velocity measurement embodiments of the present invention.

BEST MODES FOR CARRYING OUT THE INVENTION

FIG. 1 illustrates a schematic view of components employed to provide a range and velocity sensing system in accordance with one embodiment of the present invention.

FIG. 1 shows a range sensing system which incorporates a single energy source, shown in this embodiment as a single LED (2). The system (1) also includes a single receiver, shown in this embodiment as a charge coupled device camera (3).

The system (1) also incorporates an activation system, shown in this embodiment as a signal generator (4). The signal generator 4 is adapted to provide a driving signal A to operate the light source (2). This driving signal A has a frequency, defined as the source frequency, which activates and deactivates the light source (2) in a cyclic pattern.

This signal generator (4) is also adapted to provide a driving or control signal D (with a frequency equal to or defined as the receiver frequency) to a shielding system, which is shown in this embodiment by a shutter (5). The driving signal D for the shutter (5) is used to periodically block the sensing of reflecting energy from a nearby target (6) and more distant target (7) by the camera (3).

The system (1) also incorporates a processing means, implemented in this embodiment through a micro-processor (8). The micro-processor (8) receives output signals from the camera (3) and processes a number of input signals to provide the range information or indications required from the system (1).

A number of specific electrical and also optical signals A-J are also employed or generated by the system shown. FIGS. 2 a and 2 b show plots of each of these signals with respect of time, where the amplitude and frequencies of the wave forms shown are given as approximations only to illustrate the behaviour of the system.

As discussed above, the signal generator (4) is used to generate a driving source frequency A and a driving receiver frequency D used to operate the light source (2) and shutter (5) respectively. The signal generator (4) is also adapted to provide phase-locking between these driving frequencies A, D so that a receiver frequency will be phase-locked with respect to the source frequency. The signal generator is also adapted to provide a third signal E which is the result of the receiver and source frequencies A, D mixed together to create an initial reference signal E.

Signal B shown represents the modulated light generated by the source (2) and reflected from a nearby target (6) towards the shutter (5). Conversely signal C represents the modulated light from the source (2) reflected from a more distant target (7) towards the shutter (5).

Signals G and I represent a pair of mixed signals generated by the modulated light signals B, C being passed through the shutter (5) which is driven open and closed with a receiver frequency D. Signal G represents the mixed signal resulting from light reflected from a nearby target (6) (being B mixed with D) while signal I represents the mixed signal resulting from light signal resulting from light reflected from the more distant target (being C mixed with D) (7).

These two optical signals and the further input reference signal E make up inputs to the camera (3) which acts as a transducer to produce electrical output signals H, J and F which are supplied to the micro-processor (8) as inputs. Output signal H is provided through a signal generated by light intersecting the camera which is reflected from the nearby target (6), while electrical signal J is provided through light intersecting the camera reflected from the more distant target (7). Electrical signal F is generated from the initial reference signal E and is used to provide a calibration or final reference signal in the calculation of range values by the micro-processor (8).

Because signals H and J are derived from light imaged on to the camera's sensor, each of these signals represent the intensity of the pixel of which the light is intersecting. Similarly, every other pixel on the camera's sensor will generate a similar waveform relating to the light reflected from the object(s) in that pixels field of view. The combination of waveforms from all of the camera's pixels will result in a time series of images, in which each pixel in the image contains one quantised time-slot of that pixels corresponding waveform.

The micro-processor (8) operates to compare or analyse phase differences between the reference signal F and the signals generated through the reflected light from each of the targets (6) and (7). The reference signal F is representative of light reflected from a target at a zero distance from the camera (3) so that the size of the phase difference between the reference signal F and signals H and J will indicate the range of the targets (6) and (7) from the camera (3).

FIG. 3 shows more clearly a comparison of signals F, J and H with respect to one another and as compared using the micro-processor A.

As can be seen from FIG. 3 the signal H has a lesser phase difference in the signal J from the reference signal F, thereby showing that target (7) is further from the camera (3) than target (6). The actual size of this phase difference is also calculated or analysed by the micro-processor (8) to assign a specific distance value to the targets (6, 7) and therefore provide range values.

FIG. 4 shows velocity component vectors calculated in conjunction with velocity measurement embodiments of the present invention.

In the embodiments shown the present invention includes three separate energy sources, S₁, S₂ and S₃ all of which are spatially displaced from one another. The source frequencies of each energy source are also slightly different from one another allowing each energy signal when received by a receiver (R) to be individually resolved.

In the situation shown, energy emitted by each source is directed towards and scattered from a target (T). Energy from each source S₁-S₃ is scattered from a target and detected at the single receiver (R).

The target (T) is moving within the scene under investigation and therefore each of the source frequencies S₁-S₃ will be frequency or doppler shifted depending on the actual or real velocity of the target. A velocity component of the real velocity of the target is calculated through measuring the doppler shift experienced by each source frequency.

The direction of the velocity components calculated are shown through bisection vectors (D₁, D₂, D₃). The direction of each velocity component for each source is determined by the direction of the bisection vector (D₁, D₂, D₃) which bisects the vectors formed which extend to the source from the target and from the target to the receiver.

Using these three distinct velocity component measurements the true velocity vector (V_((T))) calculated can be calculated through V _((T)) =f(ΔS _(1(D1)) ,ΔS _(2(D2)) ,ΔS _(3(D3))) where V_((T)) is the true velocity vector or the target (T), ΔS_(1(D1)), ΔS_(2(D2)), ΔS_(3(D3)) are the doppler shifts or changes in frequency of each source and direction indicated, f, the function employed uses the standard vector mathematics to calculate V_((T)) in three dimensions.

Those skilled in the art should also appreciate that the time derivative of such velocity vectors may also be calculated to obtain acceleration values or indications for the target involved. Acceleration components in the directions of each of the velocity vectors discussed above may be calculated independently or alternatively a time derivative of the true velocity vector V_((T)) may be calculated if required.

Aspects of the present invention have been described by way of example only and it should be appreciated that modifications and additions may be made thereto without departing from the scope thereof as defined in the appended claims. 

1. A velocity sensing system which includes: at least one energy source adapted to emit light energy capable of reflection by one or more targets of a plurality of targets within a region, and at least one receiver having a plurality of sensing elements wherein at least one sensing element is configured to sense the reflection of emitted light energy from the energy source from at least one of said plurality of targets within said region, and an activation system associated with said at least one energy source, said activation system being adapted to activate and deactivate the energy source in a cyclic pattern with a selected source frequency, and a shielding system associated with said at least one receiver, said shielding system being configured to block the sensing of reflected light energy from the plurality of targets by said at least one receiver, said shielding system being activated and deactivated in a cyclic pattern with a selected receiver frequency, said source frequency and receiver frequency being selected from different frequency values, and wherein each sensing element of the receiver is configured to generate an output beat signal at a frequency substantially equal to the frequency difference between the receiver frequency and the frequency of the reflected source signal detected by the sensing element, and a processing means configured to measure a frequency change in the output beat signal generated by each of the plurality of sensing elements of the receiver with respect to the frequency difference between the source frequency and receiver frequency and to calculate a velocity component in a known direction for each target of the plurality of targets within the region sensed by the receiver, substantially at the same time.
 2. A velocity sensing system as claimed in claim 1 wherein a source signal from a single energy source is used to determine a single velocity component for a target in a particular direction.
 3. A velocity sensing system as claimed in claim 1 wherein the known direction of the velocity component calculated is equal to the direction of a vector which bisects both of a vector extending to the energy source from the target and a vector extending from the target to the receiver.
 4. A velocity sensing system as claimed in claim 1 wherein the source frequency used is phase locked with respect to the receiver frequency used.
 5. A velocity sensing system as claimed in claim 4 wherein a single signal generator generates a receiver frequency which is phase locked with respect to a source frequency generated by the same signal generator.
 6. A velocity sensing system as claimed in claim 1 wherein an output signal of a receiver has a frequency equal to the frequency difference between a source frequency and a receiver frequency.
 7. A velocity sensing system as claimed in claim 1 wherein an energy source emits visible light energy.
 8. A velocity sensing system as claimed in claim 7 wherein an energy source is formed from a light emitting diode.
 9. A velocity sensing system as claimed in claim 7 wherein the receiver is implemented by a charged coupled device.
 10. A velocity sensing system as claimed in claim 1 wherein the velocity sensing system includes a single receiver only.
 11. A velocity sensing system as claimed in claim 1 wherein the activation system controls the supply of power to an energy source.
 12. A velocity sensing system as claimed in claim 1 wherein the shielding system is implemented through a physical barrier.
 13. A velocity sensing system as claimed in claim 1 wherein the shielding system is implemented through an enable signal applied to operate a receiver.
 14. A velocity sensing system as claimed in claim 1 which includes a plurality of light energy sources configured to allow the concurrent calculation of a plurality of velocity components for a target.
 15. A velocity sensing system as claimed in claim 14 wherein said plurality of energy light sources are spatially displaced from one another.
 16. A velocity sensing system as claimed in claim 14 wherein each of the plurality of light energy sources are activated and deactivated with a different source frequency.
 17. A velocity sensing system as claimed in claim 1 wherein the calculated velocity component is integrated with respect to time to give an acceleration value in the known direction of the calculated velocity component.
 18. A method of calculating at least one velocity component of a plurality of targets within a region, comprising; i) activating a light energy source using an activation system, said source being activated and deactivated in a cyclic pattern with a selected source frequency, and ii) operating a receiver having a plurality of sensing elements configured to sense the reflection of emitted energy from at least one of said plurality of targets within said region using a shielding system, said shielding system being configured to block the sensing of reflected light energy from a plurality of targets in a cyclic pattern with a selected receiver frequency, said source frequency and receiver frequency being selected from different frequency values, and wherein each sensing element of the receiver is configured to generate an output beat signal at a frequency substantially equal to the frequency difference between the receiver frequency and the frequency of the reflected source signal detected by the sensing element, and iii) measuring a frequency change in the output beat signal generated by each of the plurality of sensing elements of the receiver with respect to the frequency difference between the receiver frequency and the source frequency of the energy source signal, and iv) using the measured frequency change of the source signal to calculate a velocity component of the target in a known direction for each of the plurality of targets within the region sensed by the receiver. 